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The  Dynamics  of  Two  Coupled  Rigid  Bodies 


R.  Grossman*,  P.S.  Krishnaprasad**,  and  Jerrold  E.  Marsden*** 


'Abstract 


In  this  paper  we  derive  a  Poisson  bracket  on  the  phase  space  so(3)  x  bo(3)*  x  S0(3]  such  that 
the  dynarriics  of  two  three  dimensional  rigid  bodies  coupled  by  a  ball  and  socket  joint  can  be  written 
as  a  Hamiltonian  system. 

$1.  latroductioxr 


§1.  latrpductioxr 

lL 

In  this  paper  we  introduce  a  Poisson  bracket  on  the  phase  space  , 


so(3)*  X  ao(3)*  X  SO(3). 


^ere  «o(3)*  is  the  dual  of  the  Lie  algebra  of  S0(3),  to  that  the  dynamics  of  two  rigid  bodies  / 

coupled  by  a  ball  and  socket  joint  can  be  written  as  the  Bamilitonian  system  H  s  {FtH)  This  { 

sets  the  stage  so  that  the  stability  and  asymptotics  of  the  system  can  be  studied  using  the  energy 
Casimir  method  as  in  Holm,  Marsden,  Ratiu  and  Weinstein  [1985]  and  Krishnaprasad  [1965],  so  that 
chaotic  solutions  can  be  found  using  the  Melnikov  method  such  as  in  Holmes  and  Marsden  [1983]; 
so  that  bifurcations  of  the  system  can  be  described  using  the  techniques  in  Golubitsky  and  Stewart  — — 
[1986]  and  Lewis,  Marsden  and  Ratiu  [1986],  and  so  that  control  issues  can  be  studied,  as  in  Sanchez 

de  Alvarez  [1986].  -  I 

The  dynamics  of  planar  coupled  rigid  bodies  has  been  studied  using  similar  ideas  in  Sreenath. 
Krishnaprasad  and  Marsden  [1986].  i 


/  f'  '  I  c 


rnr'f  I 
f.TEl 


$2.  Kinematics 


In  this  section  we  will  derive  the  Lagrangian  describing  the  free  motion  of  two  rigid  bodies^on/ 
coupled  by  a  ball  and  socket  joint.  At  time  0  we  assume  that  the  two  coupled  rigid  bodies  are  in  a  Codes 
reference  configuration  denoted  B  ■  Fix  an  inertial  frame  and  let  Q  denote  a  point  in  the  reference'  -  — ■ 

configuration  B  .  Let  0i  denote  those  points  Q  €  B  which  belong  to  body  1  and  let  Bj  denote^  ' 
those  points  which  belong  to  body  2.  i 
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The  configur&tioD  at  time  (  it  determined  by  a  smooth  map 


We  can  also  specify  the  configuration  at  time  (  as  follows.  First  we  specify  the  position  of  the  joint 
with  respect  to  the  inertial  frame  Denote  this  as  tx>(().  Fix  a  frame  centered  at  the  joint  and  parallel 
to  the  inertial  frame.  With  respect  to  this  frame,  the  configuration  of  body  1  is  determined  as  usual 
by  three  Euler  angles.  The  Euler  angles  determine  the  orientation  of  a  body  fixed  frame  relative  to 
the  spatial  frame  centered  at  the  joint.  Alternatively  these  two  frames  are  related  by  an  element 
>4i(t)  €  S0(3).  Similarly  the  configuration  of  body  2  is  determined  by  an  element  Aj{t)  €  S0(3). 
We  conclude  that  the  configuration  space  is 

C  =  S0(3)  X  S0(3)  X  R* 


and  that 


=  Ai(l)0+ «;(<).  forQcEi 
«(Q.O  =  Aj(t)Q  +  tK(t).  forQeBj. 


(2.1) 


We  now  proceed  to  compute  the  kinetic  energy  of  the  system  This  requires  that  we  keep  track 
of  the  centers  of  mass  of  the  two  bodies  and  the  center  of  mass  of  the  system  relative  to  the  fixed 
inertial  frame  as  well  as  the  frame  centered  at  the  joint.  Let  m^  and  mj  denote  the  masses  of  the 
two  bodies  and  let  m  denote  the  total  mass.  Let  denote  the  center  of  mass  of  body  1  in  the 
reference  configuration  relative  to  the  inertial  frame  and  let  Sf  denote  the  center  of  mass  for  body 
2.  Let  ri(t]  denote  the  center  of  mass  of  body  1  at  time  t  relative  to  the  inertial  frame  and  let  r2(f) 
denote  the  center  of  mass  for  body  2.  Let  Si(f)  and  S}(f)  denote  the  center  of  mass  of  bodies  1  and 
2,  respectively,  measured  with  respect  to  the  frame  centered  at  the  joint.  Finally  let  a{t)  denote  the 
center  of  mass  of  the  ensemble  measured  with  respect  to  the  inertial  frame  Figures  1  and  2  show 
the  relationships  of  these  quantites.  For  example  the  following  equations  can  be  read  off  from  the 
figures 

si(<)  =  Ai(<)Sj  =  w(f)  +  si(t) 


=  *■,(<)  =  ir(t)  +  s,(<) 


(2.2) 


1 


Given  two  vector*  v  ~  and  u’  =  (u'* , ui*. ti;’) ,  denote  their  inner  product  relative  to 

the  standard  Euclidean  structure  m 

{v,w)  =  ^V*Ul\ 

•  ml 

and  the  corresponding  nonn  by  |t)|.  Let  ft{Q)  denote  the  mass  measure  of  the  ensemble  in  the 
reference  configuratioD.  The  kinetic  energy  KE  of  the  configuration  is 

KE  =5j^|?(<)I<l/i(0) 

=  Ui{0Q  +  u>{01’MC)  +  (i-2) 

=  5  +  (1  --  2) 

=  {j/s,  -‘<'(0)}“''^ 

+  <3‘  dp(<3)}  2). 

Let  /i  denote  the  coefficient  of  inertia  matrix  of  body  1,  defined  by 

{hf  =  I  MQ)^  for  i.i  =  1,2,3. 

JBi 


(2.3) 


(2.4) 


The  coefficient  of  inertia  of  body  2  is  defined  similarly  Using  these  definitions  and  the  defintion 
of  the  center  of  mass,  we  can  rewrite  the  expressions  above  as 

KE  s  itr  (yii7,y4l)  +  ~^(u.u-)  +  nn(>i,S?.u/)  +  (1^2) 

1  m  (2.5) 

=  itr  (Mi/Ml)  +  m,(>4,S?,u-)  +  (1  -  2)+  y(u..u') 

The  Lsgrangian  is  simply  the  total  kinetic  energy  To  summarize,  the  velocity  phase  space  for 
our  system  is  750(3)  x  750(3)  x  7R^  and  the  Lsgrangian  is  given  by  (2.5). 

{3.  Reduction  by  the  Euclidean  Group 

Consider  the  following  action  of  an  element  g  of  the  Euclidean  group  E(3) 

'*(o  l)’ 

where  A  €  SO(3)  and  h  €  R’,  on  a  point  (i4i,i42.w)  in  the  configuration  space  C: 


f  (Ml ,  M],  to)  =  (5Mi,  BA,.  Bw  -f  »).  (3.1) 

It  is  easy  to  check  that  the  Lsgrangian  (2.5)  is  invariant  under  this  action.  Since  the  Lsgrangian 
ia  invariant  under  £(3)  ,  so  is  the  Hamiltonian.  The  purpose  of  this  section  is  to  perform  the 
reduction  by  this  group.  This  will  be  done  in  two  steps  First  we  will  reduce  by  R’;  this  accounts 
for  conservation  of  total  linear  momentum.  Then  we  will  reduce  by  SO(3);  this  accounts  for 
oonservatiC'D  of  total  angular  momentum. 

We  begin  by  rewriting  the  Lagragian  in  terms  of  the  linear  momentum  p.  Using  (2.2),  we  can 
write  the  total  linear  momentum  as 

p  s  md  s  mifi  +  mjrj 
K  mw<f  m|M|5j  +  mjMjSj. 


S 


w.  r 


It  ia  coDveoieDt  to  introduce  the  expreuioa 


mj 


m 


m 


(33a) 


kad  write 


u,  =  a-^A,Sf-^A,Sf 

fn  ffi 

w  =  6 

Subatitutiag  (3.3a  aad  b)  into  (2.5)  and  aimplifyia(  givea  the  following  form  for  the  Lagrangian 


(3.36) 


L  =  itr  (At7tAl)-htr  (>i,/j>4j)  -h  ^(p,p)  -  j(p,p) 

The  Legendre  tranaformation  FL  iaducea  a  lymplectic  atructure  on 

TC  =  rSO(3)  X  rSO(3)  x  TR* 


(34) 


and  the  tangent  of  the  action  of  R’  on  C  (aee  (3  1))  ia  aymplectic.  To  verify  thia  atatement  and  the 
onea  that  follcrw,  aee  Abraham  and  Maraden  [1978],  chapters  3  and  4.  The  momentum  map  for  this 
action  ia  given  by 

J  :  TSO(3)  X  rSO(3)  X  TR®  —  R** 

(Ai,Ai,Ai,A3,v),u))  ^  p. 

The  corresponding  reduced  space  at  p  is. 

(j-‘(p))  /R*  =  rso(3)  X  rso(3). 


F^om  (3  4)  we  see  that  the  Lagrangian  on  the  reduced  space  ia  simply 

L  =  itr  (A, /Ml)  +  itr  (Aj/jAj)  -  ^  +  m,A,SS|*  +  ^  (3  5) 

Since  p  is  constant,  we  can  drop  the  last  term.  This  completes  the  first  stage  of  the  reduction 

We  now  perform  the  reduction  corresponding  to  conservation  of  total  angular  momentum  This 
time  we  use  Poisson  reduction;  see  Krishnapraaad  and  Marsden  [1986]  for  a  sununary  of  Poisson 
reduction.  Consider  the  map 

X  :  r  (SO(3)  X  SO(3))  —  To(3)-  X  so(3)*  x  SO(3) 

(Di.Dj.A)  =  (7” Ar*Aj) . 


We  will  define  a  Poisson  bracket  on  the  target  space  so  that  the  map  X  becomes  a  Poisson  map  with 
reapect  to  this  bracket  and  the  canonical  bracket  on  the  cotangent  bundle  7*  (SO(3)  x  SO(3)) . 
Introduce  the  body  angular  velocities  of  each  of  the  bodies 


iii  =  Af’Aj 


(3.7) 


where  Cl  is  the  linear  map  v  0  x  v  on  R*.  We  will  also  need  the  moment  of  inertia  Ji  of  body  1 
given  by 

(lOl’-(C‘)’)  dp(Q).  if'-i 

The  moment  of  inertia  7]  of  body  2  in  defined  in  a  similar  way. 


/  0'Q>dM(Q),  iti^j 
JBx 


Is  order  to  derive  an  explicit  exprssioo  for  the  angular  momenta  of  the  lyatem,  it  is  helpful 
to  write  the  total  kinetic  energy'  as  a  quadratic  form.  After  a  certain  amount  of  algebra,  the  total 
kinetic  energy  (3.5),  can  be  written 


where 


(3.9a) 


a  =  (^)‘>4(s5) 


(3.96) 


<  = 


fPIl  fTlj 

m 


Let  J  denote  the  matrix 


/,) 

From  the  Legendre  transformation  applied  to  Lagrangians  quadratic  in  the  velocities,  the  angular 
momenta  are  found  to  be 

The  inertial  orientation  matrices  Ax ,  A3  determine  the  relative  orientation  matrix 

A  =  Ar‘Aj.  (3.10) 

Using  the  definitions  (3.7)  -  (3.10),  we  can  rewrite  the  Lagragian  (3.5)  as 

Ls|nj">n  (3.11) 

and  conclude,  using  the  fact  that  the  Lagragian  is  quadratic  in  the  momenta,  that  the  Hamiltonian 
^(ni,n],A)  is  also  given  by  (3.11). 

We  next  derive  the  Poisson  bracket  on  so(3)*  x  io(3)*  x  SO(3).  Given  a  function  F  on  so(3)*  x 
•0(3)*  X  SO(3),  define  a  function  Fx  on  r  (SO(3)  x  SO(3))  by 

Fx  =  FoX.  (3.12) 

The  canonical  bracket  on  7*  (SO(3)  x  SO(3))  is 

{Fx,Cx)^Dxx,Fx  Da, Hx  ^ 

•^Da^Fx  y^-DA,Hx 

Using  the  chain  rule,  we  can  introduce  a  bracket  on  ^0(3)*  x  >0(3)*  x  S0(3),  so  that  A  becomes  a 
Poisson  map  This  is  straghtforward  but  tedious.  To  organize  the  computation,  it  is  helpful  to  note 
the  following  facta. 

Fact  1.  If  #4  €  T^S0(3),  thee 

n  :=  7714  •  =  A'ir4  €  •0(3)"  (3.14) 

Fact  2.  Let  /fx(Ai,wi,A3,W2)  be  a  function  on  T*  (S0(3)  x  S0(3))  and  let  denote  the  func¬ 
tional  derivative  of  J/x  ^itb  respect  to  r|.  Then 

Fhct  3.  Let  Fx(Ai,wi,A3,W3)  be  a  function  on  T"  {S0(3)  x  S0(3)),  where  we  have,  by  abuse  of 
Botntion,  written  an  element  in  the  cotangent  space  at  Ax  as  (A],#}).  Then 

DA,Fx(Ax,rx,A3,r3)(6Ai)  w 

It  is  DOW  straightforward  to  combine  these  facta  to  see  that  the  canonical  bracket  (3.13)  may 
be  written  in  terms  of  the  ftictions  F  end  G  using  the  chain  rule  as 

(r.ii)(B,.v,.x) .  -(n,.  [tt.  tSl)  -  (d,.  it;]) 


(3.13) 


(3.15) 


To  summarise,  we  have 


Theorem  I.  (i)  With  tbe  ctJtoDicMl  br^et  on  T‘{SO(3)  x  SO(3))  tad  tbe  brxciet  (3  15)  on 
k>(3)'  k  $0(3)'  X  SO(3),  tbe  aixp 


X  :  T‘(SO(3)  X  SO(3))  $o(3f  x  mfj/  x  SO(3) 

given  by  (3.6)  is  a  Poisson  mmp.  (ii)  Tbe  dynamics  on  tbe  reduced  spnce  is  given  by 

F={F.H). 


{4.  Further  Remarks 

1.  We  begin  with  a  brief  discussion  of  the  Cssimirs.  Consider  the  momentum  map 
J  :  r  (SO(3)  X  SO(3))  so(3)* 

The  composition  of  this  with  the  Casimir 

C  :  so(3)’  —  R 

n-IDi’ 


(41) 


(4.2) 


produces  a  collective  Hamiltonian  on  T*  (SO(3)  x  SO(3))  whose  Hamiltonian  vector  field  is  tangent 
to  the  G— orbits  (see  Guillemin  and  Sternberg  [19S0]  or  Holmes  and  Marsden  [1983])  and  therefore 
induces  a  Casimir  C  on  the  space  so(3)*  x  ao(3)*  x  SO(3)  via  the  Poisson  map  (3.6). 

Tracing  through  the  diagram  shows  that  C  =  [Hi  -f  ;  and,  hence,  any  function  of  the 
form  4  is  a  Casimir  for  the  bracket  (3. 15). 

2.  The  symplectic  leaves  in  the  nine  dimensional  space  so(3)*  x  •o(3)*  x  SO(3)  appear  to  be 
eight  dimensional  (level  sets  of  the  function  |I]j  -f  i4II}|’)  and  in  the  case  of  J  s  0,  (given  by  (4.1).) 
the  six  dimensional  space  7*50(3);  and,  finally,  if  Hi  s  O,!!)  =  0,  a  two  dimensional  space  5^  of 
trival  equilbria.  We  expect  to  explore  tbe  geometry  of  these  leaves  and  tbe  other  topics  listed  in  the 
introduction  in  a  future  publication. 
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